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ABSTRACT 


yu. pa per concent the (oppression of the vibration of a large flexible robot by inertial forces of a 
•mall robot which » located at the tip of the large robot A controller for generating damping forces to a 
large robot is designed based on the two time scale model. The controller does not need to calculate the 
quasi-steady-state variables and is efficient in computation. Simulation results show the effectiveness of the 

forces and the controller des i g n ed. 

L INTRODUCTION 

The desire to improve manipulator arm performance has lead to designs with lighter arm structures. 
A light e lastic structure responds to motion or disturbances with undesirable vibration, which must be 
either actively or passively damped before most manipulation tasks can be completed. A number of 
researchers have explored actively damping the vibrations with the joints of the flexible arm. [1A3] While 
this can be very effective, it requires high bandwidth servo control of the joints, with actuator bandwidth 

exceeding the vibrational frequencies to be damped. 

This paper considers an alternative active control approach that is useful when additional degrees of 
freedom are available at the tip of the arm. In particular, we consider a small arm mounted on the end of 
a larger arm. This configuration is representative of proposed space manipulators and of bracmg 
manipulators under study in several laboratories [4]. The small arm is used in this study to generate 
inertial forces on the large arm to cancel large arm vibrations. It is easier to provide high bandwidth 
actuators for a small arm than for a large arm. The large arm’s function is to provide a base for the small 
ann, brin ging the task into the small arm’s work space. Highly accurate motion is not needed for the 
large arm, and providing it solely for active vibration control is a major compromise in cost and 
complexity. In fact, the large arm could be brought to position against a mechanical stop, or moved with a 
very simple on-off or open loop control. 

This study involves simulation of a physical system for which later experiments are planned. The 
large arm, designated RALF (Robotic Arm Large and Flexible), is comprised of two ten foot long links 
and two hydraulically actuated joints. The second joint is actuated through a parallelogram mechanism by 
an actuator located near the base. Details on RALF, its modeling and experiments verifying its behavior 
are described in [5]. The small arm, designated SAM (Small Articulated Manipulator), is electrically 
powered and remains under construction at this time. It’s three rotational joints give a spatial motion, but 
only two joints are considered here. As considered here SAM’s first joint, which rotates about RALFs 
second link, has placed the four remaining joint axes of the system in a parallel direction and all motion 


considered is coplan ar. 
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2. DYNAMIC MODELING 

Figure 1 shows a large flexible robot carrying a small rigid robot at its tip. There are four joint 
variables and number of vibration variables. The most important variables to describe the dynamic 

system are four angles and one vibration variable for each flexible link [6]. However, in order to 

study the effectiveness of the inertial forces of a smaD robot, the angles of the large robot are assumed to 

be inva riant By following [5], the dynamic equations of motion for the robot can be written in the 
following form. 
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where, 

M(0,q) is the inertia matrix, 

N(0,d,q,q) includes nonlinear and gravity terms, 

K is the stiffness matrix of the flexible robot, 

9 is the vector of joint angles of small robot, 
q is the vector of vibration amplitudes and 
U is the actuator torque vector. 

The perturbation technique is a useful method for simplifying the equations and reducing 

the order with modest reduction of model accuracy [7j. The flexible robot designed for industrial 
application, could have relatively high stiffness. In this case, the reduced order models comprised of fast 
and slow subm od els can keep its original dynamic characteristics with negligible order of errors. The two 
reduced order submodels can be obtained by following [10,11] for the flexible robot. The equation (1) 
can be expressed as, 


9 - -H 12 Kq - H n Nj - H 12 N q + H n U 

( 2 ) 

q - - H 22 Kq - H 21 N, - Wq ♦ H^U 


where H is the inverse of mass matrix M(0,q) and subscript i and j denote the corresponding submatrix. 

To make the equation (2) a standard form as in [3], the inverse of the smallest spring constant k is 
sdected as a perturbation parameter /i(» 1/k). Then, the equation (2) can be written as following forms: 


- V - H 11 N * - H 12 N q + H li u 


(3a) 


* “ ' *H 22 z - KH 21 N, - KH 22 N q ♦ KH 21 U 
where, K * flK, z * Kq, Hy - Hy(djXz), and N s - H(9 ,& JizJtz). 


(3b) 


The equation for the slow submodel can be obtained by assuming #1-0 which regards the flexible 
finks as rigid. Substituting 0-0 into the equation (3), we can obtain the following equations. 

i - Hj" 1 (- H 2] N ( - H 22 N q + H 21 0) <4) 

• - * * fill", ‘ fil2 S , + fill 0 l5) 

where bars are used to denote corresponding terms when p - 0 meaning the model dynamics are resticted 
to quasi-steady-state variables z. U is a slow control torque vector. The equation of slow submodel is 
obtained from equations (4) and (5) as 


# - MjJVh, + 0) (6) 

The equation (6) is the same as that of a rigid robot _ 

In order to obtain the equation for the fast submodel, a scaled time T«t/J£ is introduced. Then, 

the equation (3b) can be rearranged as 

n' - - K h 22 D + K h 21 u f < 7 > 

where TJ - z-I represents the deviation vector of the fast variables from the quasi-steady-state variables 
z, Uf ■ U - U denotes fast control torque vector, and ' indicates differentiation with respect to T. The 

equation (7) represents the fast submodel dynamics. 

3. CONTROLLER DESIGN 

To sta b* 1 *™ the two submodels, a composite control law is, generally, adopted [10] as 
U - U(0) + UK*?) 

The slow controller is used for controlling a rigid robot while the fast controller is used for forcing the fast 
deviation vector to approach to zero. For the slow submodel control, most of the well developed control 
laws for the rigid robot can be applied [9]. The nonlinear feedback controller is chosen as in [11]. 

0 • fi, + fin ( 'd • V* • *d> • v* • v> (8) 

where, subscript d denotes a desired value while K* and Kp are gain matrices. 

The gain matrices should be determined to keep the time scale separation between the controller 
bandwidth and lowest vibration frequency [12]. In simulation, the gains were chosen so the small rigid arm 
behaves as two decoupled joints, each with natural frequency of 6 rad/sec and damping ratio of one. This 
punnfnK a 4 to 1 separation from the lowest vibration frequency of 4 Hz. 

The fast controller is usually designed using an optimal or eigenvalue a ssignm ent control law [9,10]. 
However, equation (7) has time-varying paramerters. Hence, those control laws may not guarantee the 
stability of the controlled system. In addition, those controllers need the information about the quasi- 


steady-state variables, z. When the order of the dynamic equations is large as is the complete model in 
HiU the computation of z takes up large amounts of processing time and may not be realistic for real 
time control. One of the main criteia for the fast controller design in this research is the capability of real 
time control. The equation (7) can be written in time t domain as 

n - - K fi 22 »7 + K H 21 U f (9) 

The equation (9) can be stabilized by applying the fast control torques as 

K H 41 11. ■ • K ri (10) 

21 f ijv' 

where, denotes velocity gain matrix. The matrix H 21 is generally not invertable but will be in this case. 
However, the inverse of the matrix can be obtained using the pseudo-inverse technique. The signal, T], 
used in the control can be written as 

• 

tj-i-z«i»Kq (11) 

Hence, the controller does not require information about z and, therefore, is efficient in computation. It 
is generally known that adding a proportional control action to the controller can improve the 
performance. One would expect to be able to stiffen the system as well as increase its damping. However, 
there are physical limitations like the torque, joint travel, and bandwidth of actuators, or the time scale 
separation between controller bandwidth and the frequency of unmodeled dynamics. The controller 
satisfying equation (11) can relax the limitation. Thus, we design the fast controller as 
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where the equation (12b) is for the case when the matrix H 21 is not invertible. The composite controller is 
given as, 

U - U(tf) + Uf(q) 

In our simulation, the equation (12a) is used. The elements of the gain matrix are determined by 
considering the frequencies of vibration , 4 and 6 Hz, as Kj^ n - “ 20 and - K T ^ /2l » 0. In 

order to compare the perfomance of the designed controller with full state feedback controller, the 
following modified nonliner pole assignment control law is designed as 

U f (l) - (K HjjfV fi J2 q - K fy q' - K fp q) (13) 

The elements of the gain matrix and are determined to yield two decoupled controllers each with a 
natural frequency of 60 rad/sec and a damping ratio of 0.5. 


4 . SIMULATION RESULTS 

The control of the small manipulator SAM was simulated using the three control schemes described 
above. The joints of RALF, the large arm, were assumed to be locked as is representative of highly geared 
drives or stiff hydraulic actuators, at - 60 degrees and $ 2 - 120 degrees. Results for an initial rate of 
df f ltf tio" of RALF (Fig. 2 , 3 and 4) with SAM in two nominal configurations and for a commanded 
motion of SAM (Fig. 5) are shown. The nominal configurations of SAM are 9 3 » 0 and 0 4 ■ 60 degrees 
(the design condition) and 9$ - 10, 0 4 - 50 degrees (the off design condition). 

First, the response of the system for no active attempt to respond to vibration of RALF is shown in 
Fig. 2. This is eaDed the passive case. Only ( 8 ) is used to compute the control of SAM. As you see, the 6 
rad/sec response of SAM’s controller has superimposed on k the higher natural frequency of RALF at 
approximately 25 rad/sec (4 Hz). The vibration of the base due to RALFs dynamics are clearly visible in 
the motion of SAM’s joints (Fig. 2) and in the displacement of the lower (Fig. 3) and upper (Not shown) 
Knit of RALF. Energy is slowly taken out of these vibrational modes by the motion of SAM as it is back 
driven by the dist urbance. No damping is included in the model of RALF. The behavior is undesirable 
due to the long settling time of over 2 seconds. 

A significant improvement in settling time of the vibration is achieved with active control of SAM in 
response to the vibrations of RALF as shown in Fig. 2$ and 4. The control is computed using both ( 8 ) 
and (12-a) and is referred to as deflection rate control Under active feedback of the deflection rates, 
vibrations are damped in less than 1/2 the time required with passive control. A significant degradation is 
observed for the off design angles of SAM as shown in Fig. 4. The effectiveness of this control is sensitive 
to both the proper gains and the placement of SAM in a configuration to most effectively damp the 
vibrations. The large excursions of joint 4 in the off design condition (Fig. 4a) render the dashed case 
unacceptable. Joint torques (not shown) are also unacceptably high in this case. 

An attempt to add deflection feedback to the deflection rate feedback is shown in Fig 2, labeled full 
state feedback. The control incorporates ( 8 ) and (13) using a pole placement scheme. The large 
excursion of SAM’s joints point to difficulties predicted with this controller. The vibration of RALF is not 
dam ped as rapidly as with the deflection rate control as can be seen from Fig. 3a-b. Other methods of 
nting full state feedback may prove more effective in future research. 

When SAM is given a step command in desired angle, substantial excitation of RALFs vibration 
results. In Fig. 5 SAM’s first joint ( 83 ) is commanded to move from 0 to 30 degrees while 0 4 is 
fftimnand^d to move from 60 to 90 degrees. Both the passive and deflection rate control complete the 
move in 1 second, characteristic of the 6 rad/sec natural frequency of the slow control as shown in Fig. 5*a. 
The deflection rate fast control eliminates the deflection displacement almost simultaneously with 
f p mpVt;™. of the commanded movement, however as seen in Fig. 5b and Fig. 5c.. The passive control 
shows vibrations continuing well beyond 4 seconds. 
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5. CONCLUSIONS 

Based on the results of simulation, the following conclusions are reached: 

L The inertia forces of the small robot are one of the effective ways to control the vibrations of 

the large flexible robot , 

2. The dynamic equations of SAM and RALF are significantly sixnplied by sing u l a r perturbation 
technique and have proper time scale separation. 

3. The dtsiff icd dam ping control law shows good performance with much less computation than 
full state feedback control laws. 

4. The «»««mn»t angles of SAM affect the performance of controller. The problems related to the 
angles will be addressed b a future paper. 
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